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SYSTEM AND METHOD FOR DETERMINING A WHEEL DEPARTURE 
ANGLE FOR A ROLLOVER CONTROL SYSTEM WXTH RESPECT TO ROAD 
ROLL RATE AND LOADING MISALIGNMENT 

RELATED APPLICATIONS 

[0001] The present invention claims priority to 
provisional application 60/487,716 filed on July 16, 2003, 
and is a continuation-in-part to US application 10/610,278 
which claims priority to U.S. provisional applications 
60/400,376, 60/400,375, 60/400,172, and 60/400,261, filed 
August 1, 2002, the disclosures of which are incorporated by 
reference herein. The present invention is also related to 
U.S. Applications 10/610,280 filed June 30, 2003 (Attorney 
Docket NO.202-0491/FGT-1680) entitled ^^SYSTEM AND METHOD FOR 
CHARACTERIZING THE ROAD BANK FOR VEHICLE ROLL STABILITY 
CONTROL", and 10/610/279 filed June 30, 2003 (Attorney 
Docket No. 202-0469/FGT-1681> entitled "SYSTEM AInD METHOD 
FOR CHARACTERIZING VEHICLE BODY TO ROAD ANGLE FOR VEHICLE 
ROLL STABILITY CONTROL". 

TECHNICAL FXELB 

[0002] The present invention relates generally to a 
control apparatus for controlling a system of an automotive 
vehicle in response to sensed dynamic behavior, and more 
specifically, to a method and apparatus for controlling the 
roll characteristics of the vehicle by characterizing the 
wheel departure angle on which the vehicle is having a 
potential rollover event. 



BACKGROUND 

[0003] Dynamic control systems for automotive vehicles 
have recently begun to be offered on various products. 
Dynamic control systems typically control the yaw of the 
vehicle by controlling the braking effort at the various 
wheels of the vehicle. Yaw control systems typically 
compare the desired direction of the vehicle based upon the 
steering wheel angle and the direction of travel . By 
regulating the amount of braking at each corner of the 
vehicle, the desired direction of travel may be maintained. 
Typically, the dynamic control systems do not address roll 
of the vehicle. For high profile vehicles in particular, it 
would be desirable to control the rollover characteristic of 
the vehicle to maintain the vehicle position with respect to 
the road. That is, it is desirable to maintain contact of 
each of the four tires of the vehicle on the road. 

[0004] In vehicle roll stability control it is desired to 

alter the vehicle attitude such that its motion along the 
roll direction is prevented from achieving a predetermined 
limit (rollover limit) with the aid of the actuation from 
the available active systems such as controllable brake 
system, steering system and suspension system. Although the 
vehicle attitude is well defined, direct measurement is 
usually impossible . 

[0005] There are two types of vehicle attitudes needed to 
be distinguished. One is the so-called global attitude, 
which is sensed by the angular rate sensors. The other is 
the relative attitude, which measures the relative angular 
positions of the vehicle with respect to the road surface on 
which the vehicle is driven. The global attitude of the 
vehicle is relative to an earth frame (or called the inertia 



frame), sea level, or a flat road. It can be directly 
related to the three angular rate gyro sensors. While the 
relative attitude of the vehicle measures the relative 
angular positions of the vehicle with respect to the road 
surface, which are always of various terrains. Unlike the 
global attitude, there are no gyro- type sensors that can be 
directly related to the relative attitude. A reasonable 
estimate is that a successful relative attitude sensing 
system utilizes both the gyro-type sensors (when the road 
becomes flat, the relative attitude sensing system recovers 
the global attitude) and some other sensor signals. 

[0006] One reason to distinguish relative and global 
attitude is due to the fact that vehicles are usually driven 
on a three-dimensional road surface of different terrains, 
not always on a flat road surface. Driving on a road 
surface with a large road bank does increase the rollover 
tendency, i.e., a large output from the global attitude 
sensing system might well imply an uncontrollable rollover 
event regardless of the flat road driving and the 3-D road 
driving. However driving on a three-dimensional road with 
moderate road bank angle, the global attitude may not be 
able to provide enough fidelity for a rollover event to be 
distinguished. Vehicular rollover happens when one side of 
the vehicle is lifted from the road surface with a long 
duration of time without returning back. If a vehicle is 
driven on a banked road, the global attitude sensing system 
will pick up certain attitude information even when the 
vehicle does not experience any wheel lifting (four wheels 
are always contacting the road surface ) . Hence a measure of 
the relative angular positions of the vehicle with respect 
to the portion of the road surface on which the vehicle is 
driven provides more fidelity than global attitude to sense 
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the rollover event when the vehicle is driven on a road with 
a moderate bank angle. Such an angle is called body-to-road 
roll angle and it is used as one of the key variables in the 
roll stability control module to compute the amount of 
actuation needed for preventing untripped rollover event. 

[0007] When the vehicle does not have one side lifted, 
U.S. Patent 6,556,908 does provide a method to calculate the 
relative attitudes and their accuracy may be affected by the 
vehicle loading, suspension and tire conditions. However, 
during a potential rollover event, such a relative roll 
angle is not a good measure of the true relative roll angle 
between vehicle body and the road surface. U.S. Patent 
application 10/459,697 filed June 11, 2003 (Attorney Docket 
No. 201-0938/FGT-1660 ) provides another way to compute the 
true relative roll angle during a potential rollover event. 
This application is suited for cases where vehicle loading 
and suspension conditions^ are very close to the nominal 
systems. If the vehicle has large loading variations 

(especially roof loading) , potential inaccuracy could cause 
false activations in roll stability controls, 

[0008] During a potential rollover event, one or two 
wheels on the inside of the vehicle turn are up in the air 
and there is an angle between the axle of the lifted wheel 
and road surface. Such an angle is called a wheel departure 
angle. If such a wheel departure can be somehow 

characterized, the true body-to-road roll angle can be 
conceptually obtained as the sum of the wheel departure 
angle and the relative roll angle calculated in U.S. Patent 
6, 556,908. 

[0009] Another way to capture the true body-to-road roll 

angle is to use the- resultant angle obtained by subtracting 
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the road bank angle for the global roll angle calculated for 
example in U.S. Patent 6,631,317, issued October 7, 2003. 
Although this method is theoretically feasible, it has 
inevitable drawbacks. The first drawback lies in the 
computation of the road bank angle, since there is no robust 
and accurate computation of road banks using the existing 
sensor set. Secondly, the global roll angle computation as 
shown in U.S. Patent 6,631,317 may be affected by the 
accuracy of the low frequency bank angle estimation. 

[0010] Therefore, the aforementioned two methods of 
computing the body-to-road roll angle may not deliver 
accurate enough body-to-road roll angle for roll stability 
control purpose in certain situations. Because each of the 
individual methods described above does provide accurate 
measure within certain conditions, a sensor fusion algorithm 
would be a way to obtain an angle good for roll stability 
control. Such a sensor fusion method needs to integrate the 
various angles and conduct signal sensitizing and 
desensitizing, which may include the computations of (i) 
global roll angle as discussed in U.S. Patent 6,631,317; 
(ii) relative roll angle as discussed in U.S. Patent 
6,556,908; (iii) a rough characterization of the road bank 
angle, which is called a reference road bank angle; (iv) 
wheel departure angle; (v) body-to-road roll angle; (vi) 
transition and rollover condition. 

[0011] By subtracting the wheel departure angle and the 
relative angle from the global roll angle, a road bank angle 
with better accuracy than reference road bank angle is 
obtained. Such road bank angle is not only needed for roll 
stability control, but also for other applications. For 
example, the road bank angle could be used in an active 
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anti-roll-bar control, the yaw stability control, etc., to 
set threshold values for various control variables . An 
active roll control system using a controlled anti-roll-bar 
does not respond suitably to the side bank in the 
conventional setting, since the presence of road side bank 
cannot be detected and the system therefore responds to a 
side bank as if the vehicle were cornering. This can result 
in unnecessary power consumption for the active anti-roll- 
bar system. In order to eliminate this, U.S. Patent 
6,282,471 provides a very crude estimation of the road bank 
using lateral acceleration sensor and vehicle reference 
speed. A vehicle driven on a road with a sharp bank may 
cause false activation for the yaw stability control system 
and/or roll stability control system due to the fact that 
large lateral motion is determined through sensor signals 
and the sensor signals (for example, the lateral 
acceleration) may be contaminated by the gravity component 
due to road bank. That is, the sensor signals might indicate 
a large lateral vehicle motion even if the vehicle is driven 
in steady state condition on the banked road. 

[0012] Therefore, it is desirable in vehicle dynamics 
control, especially for roll stability control to detect 
accurately a wheel departure angle so as to accurately 
predict the true roll position of the vehicle with respect 
the road surface to properly activate the vehicle control 
systems. It is also desirable to use wheel departure angle 
information together with other useful infonnation to 
identify various information good for setting control 
thresholds . 
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SUMMARY 

[0013] Because each of the individual methods described 
above does provide accurate measure with certain conditions, 
a sensor fusion algorithm would be a way to obtain an angle 
good for roll stability control . Such a sensor fusion 
method needs to integrate the various angles and conduct 
signal sensitizing and desensitizing, which may include the 
computations of (i) global roll angle as discussed in U.S. 
Patent 6,631,317; (ii) relative roll angle as discussed in 
U.S. Patent 6,556,908; (iii) a rough characterization of the 
road bank angle (which is called a reference road bank 
angle) ; (iv) wheel departure angle; (v) body-to-road roll 
angle; (vi) transition and rollover condition. 

[0014] In one embodiment, a control system for an 

automotive vehicle includes a roll rate sensor generating a 
roll rate signal, a lateral acceleration sensor generating a 
lateral acceleration signal, a longitudinal acceleration 
sensor generating a longitudinal acceleration, a yaw rate 
sensor generating a yaw rate signal and a controller. The 
controller is coupled to the roll rate sensor, the lateral 
acceleration sensor, the yaw rate sensor and the 
longitudinal acceleration sensor. The controller determines 
a total roll velocity from the roll rate signal, the yaw 
rate signal and a calculated pitch angle signal. The 
calculated pitch angle is a function of the static pitch 
angle plus the dynamic pitch angle called a relative pitch 
angle, which is a function of the longitudinal acceleration. 
The controller also determines a relative roll angle from 
the roll rate signal and the lateral acceleration signal. 
The controller determines a wheel departure angle from the 
total roll velocity. The controller determines a calculated 
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roll signal used for roll stability control from the wheel 
departure angle and the relative roll angle signal. The 
relative roll angle signal may be further blended with the 
other computations such as reference bank angle, global roll 
angle, vehicle rollover condition and transitional 
condition . 

[0015] In another embodiment, a method of controlling an 

automotive vehicle comprises determining a total roll angle 
velocity, determining a wheel departure angle in response to 
a total roll angle velocity, and controlling the vehicle in 
response to the wheel departure angle. 

[0016] One advantage of the invention is that the sensors 
and signals available in a roll stability control system are 
used to determine the wheel departure angle. Further, the 
processing involved in the wheel departure angle uses little 
processing resources. Another advantage is the wheel 

lifting and grounding status are used in the determination 
which may be set to extend beyond the actual time the wheels 
are lifted to account for processing delays (sensitizing) 
during wheel lifting and to reset the wheel departure angle 
to zero (desensitizing) during wheel grounding. 

[0017] Other advantages and features of the present 

invention will become apparent when viewed in light of the 
detailed description of the preferred embodiment when taken 
in conjunction with the attached drawings and appended 
claims . 

BRXEF DESCRIPTION OF THE DRAWINGS 

[0018] Figure 1 is a diagrammatic view of a vehicle with 

variable vectors and coordinator frames . 



8 



[0019] Figure 2 is an end view of an automotive vehicle 

on a bank with definitions of various angles including 
global roll angle, relative roll angle, wheel departure 
angle (WDA) , road bank angle and body-to-road angle. 

[0020] Figure 3A is an end view of an on-camber divergent 
vehi c 1 e t endency . 

[0021] Figure 3B is an end view of an automotive vehicle 
in an off -camber divergent condition. 

[0022] Figure 3C is an end view of a vehicle in an on- 

camber convergent condition. 

[0023] Figure 3D is an end view of a vehicle in an off- 
camber convergent condition. 

[0024] Figure 4A is a block diagram of a stability 
control system. 

[0025] Figure 4B is a block diagram of the controller 26 
used in the stability control system depicted in Figure 4A. 

[0026] Figure 5 is a block diagrammatic view of the unit 
27 depicted in Figure 4B, which is used for quantitatively 
and qualitatively determining rollover trend of a. vehicle. 

[0027] Figure 6 is flow chart of the operation of one 

embodiment of the present invention. 

[0028] Figure 7 is a plot of true roll angle, relative 

roll angle, wheel departure angle, and relative roll angle 
plus wheel departure angle. 
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[0029] Figure 8 is a side view of a vehicle driven on a 
flat but tilted road surface with indications of various 
angular rates experienced by the vehicle. 

[0030] Fig 9 is an end view of a vehicle driven on a 
banked road during a potential rollover event. The roll 
angles of the sensor frame and body- fixed frame are both 
shown here . 

[0031] Figure 10 is a . side view of a vehicle with 
different pitch misalignments. 

[0032] Figure 11 is flow chart of the operation of one 

embodiment of the present invention. 

DETAILED DESCRIPTION 

[0033] In the following figures the same reference 

numerals will be used to identify the same components. The 
present teachings may be used in conjunction with a yaw 
control system or a rollover control system for an 
automotive vehicle. However, the present teachings may also 
be used with a deployment device such as airbag or roll bar. 

[0034] Referring to Figure 1, an automotive vehicle 10 on 
a road surface 11 with a safety system is illustrated with 
the various forces and moments thereon. Vehicle 10 has 
front right and front left tires 12a and 12b and rear right 
tires and rear left tires 13a and 13b, respectively. The 
vehicle 10 may also have a number of different types of 
front steering systems 14a and rear steering systems 14b 
including having each of the front and rear wheels 
configured with a respective controllable actuator, the 
front and rear wheels having a conventional type system in 
which both of the front wheels are controlled together and 
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both of the rear wheels are controlled together, a system 
having conventional front steering and independently 
controllable rear steering for each of the wheels, or vice 
versa. Generally, the vehicle has a weight represented as 

Mg at the center of gravity of the vehicle, where g=9.Sm/s 
and M is the total mass of the vehicle. 

[0035] As mentioned above, the system may also be used 
with active/semi-active suspension systems, anti-roll bar or 
other safety devices deployed or activated upon sensing 
predetermined dynamic conditions of the vehicle. 

[0036] The sensing system 16 is part of a control system 
18. The sensing system 16 may use a standard yaw stability 
control sensor set (including lateral acceleration sensor, 
yaw rate sensor, steering angle sensor and wheel speed 
sensor) together with a roll rate sensor and a longitudinal 
acceleration sensor. The various sensors will be further 
described below. The wheel speed sensors 2 0 are mounted at 
each corner of the vehicle, and the rest of the sensors of 
sensing system 16 may be mounted directly on the center of 
gravity of the vehicle body, along the directions x,y and z 
shown in Figure 1 . As those skilled in the art will 
recognize, the frame from b^, Z?2 and th, is called a body frame 
22, whose origin is located at the center of gravity of ■ the 
car body, with the corresponding to the x axis pointing 
forward, 62 corresponding to the y axis pointing off the 
driving side (to the left) , and the b^ corresponding to the 
z axis pointing upward. ftj, ^2 ^ interchangeable 

with Xf,,y^ and in this invention disclosure. The angular 
rates of the car body are denoted about their respective 
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axes as ty^ for the roll rate, (Oy for the pitch rate and 0)^ 

for the yaw rate. If in case the vehicle sensor frames are 
different from the vehicle body- fixed frames, a sensor frame 
directions of x^^y^ and will be used. In this case, the 
angular rate variables measured in the body frames will be 
denoted as (Oi^^ , cOfyy and ^y^^ and the angular rate variables 

measured in the sensor frame will be denoted as co^^^ , co^y and 

O)^^ . The calculations set forth herein may take place in an 
inert ial frame 24 that may be derived from the body frame 22 
as described below. 

[0037] The angular rate sensors and the acceleration 

sensors are mounted on the vehicle car body along the body 
frame directions bi, bj and 63, which are the x—y-z axes of 
the vehicle's sprung mass. If in case the vehicle sensor 
frames are different from the vehicle body-fixed frames, the 
angulai" irate sensors and the acceleration sensors are 
mounted on the vehicle car body along the sensor frame 
directions jc^, y^ and z^ - The longitudinal acceleration 
sensor 3 6 is mounted on the car body located at the center 
of gravity, with its sensing direction along foj-axis, whose 
output is denoted as . The lateral acceleration sensor 32 
is mounted on the car body located at the center of gravity, 
with its sensing direction along Z72-axis, whose output is 
denoted as Uy , If in case the vehicle sensor frames are 

different from the vehicle body-fixed frames, the 
accelerations along the sensor frames will be denoted as 
^sx^ ^sy ^sz ' accelerations along the body frames 

will be denoted as a^^^., a^.^ and a^^^ . 
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[0038] The other frame used in the following discussion 
includes the road frame, as depicted in Figure 1. The road 
frame system rir2/3 is fixed on the driven road surface, where 
the axis is along the average road normal direction 

computed from the normal directions of the four-tire/road 
contact patches. 

[0039] In the following discussion, the Euler angles of 

the body frame 6|^fi|3 with respect to the road frame are 
denoted as O^^- Oy^ and d^j. , which are also called the relative 

Euler angles. If in case the vehicle sensor frames are 
different from the vehicle body-fixed frames, the calculated 
6^j.6yj. using the senor frame signals are the same as the 

calculated d^^.^yr ^sing the body frame signals due to the 

fact that ^xr.^yr reflect the dynamic portion of relative 

attitudes which are not affected by the constant 
misalignment angles between the sensor frames and the body 
frames . 

[0040] Referring now to Figure 2, the relationship of the 
various angles of the vehicle 10 relative to the road 
surface 11 is illustrated. The present teaching determines 
a wheel departure angle G^^da ' which is the angle from the 
axle or the wheel axis to the road surface 11. Also shown 
is a reference road bank angle , which is shown relative 

to the vehicle 10 on a road surface. The vehicle 10 has a 
vehicle body 10a and vehicle suspension 10b. The relative 
roll angle is the angle between the wheel axle and the 

body 10a. The global roll angle 0^^ is the angle between the 
horizontal plane (e.g., at sea level) and the vehicle body 
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10a. If the sensor frames are different from the body 
frames, the misalignment angles between the body frames and 
the sensor frames will be inserted in to the above plot. 
Such misalignment angles will be used in the second part of 
this invention and they are depicted in Figure 9 and 10. 

[0041] Referring now to Figure 3A, vehicle 10 is 
illustrated in an on-camber divergent state. The on-camber 
divergent state refers to the vehicle having a greater than 
0 wheel departure angle, a greater than 0 relative roll 
angle, and a moment represented by arrow 2 5 tending to 
increase the relative roll angle and the wheel departure 
angle. In this example, the bank angle is less than 0. 

[0042] In Figure 3B, when the bank angle is greater than 

0, the wheel departure angle is greater than 0, the relative 
roll angle is greater than 0 and the moment is also to the 
right or increasing the relative roll angle and the wheel 
departure angle, the vehicle is in an off -camber divergent 
state . 

[0043] Referring now to Figure 3C, a bank angle of less 

than 0, a wheel departure angle greater than 0, and a 
relative roll angle greater than 0 is shown with a roll 
moment 2 5 acting to the left. Thus, the vehicle is in an 
on-camber convergent state. That is, the convergent state 
refers to the vehicle tending towards not overturning. 

[0044] Referring now to Figure 3D, when the bank angle is 
greater than 0, the wheel departure angle is greater than 0, 
and the relative roll angle is greater than 0 and the roll 
moment is tending to the left, the vehicle is in an off- 
camber convergent state. That is, the vehicle is tending 
toward not rolling over. 
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[0045] Referring now to Figure 4A, one embodiment of a 

roll stability control system 18 is illustrated in further 
detail having a controller 2 6 used for receiving information 
from a number of sensors which may include a yaw rate sensor 
28, a speed sensor 20, a lateral acceleration sensor 32, a 
roll rate sensor 34, a steering angle sensor (hand wheel 
position) 35, a longitudinal acceleration sensor 36, and 
steering angle position sensor 37. 

[0046] In one embodiment, the sensors are located at the 

center of gravity of the vehicle. Those skilled in the art 
will recognize that the sensors may also be located off the 
center of gravity and translated equivalently thereto. The 
sensors are mounted along the sensor frames and the sensor 
frames are different from the vehicle body frames, an Euler 
transformation can be conducted to transfer the sensor frame 
signals to body frame signals using the calculated 
misalignment angles between those two sets of frames. 

[0047] Lateral acceleration, roll orientation and speed 
may be obtained using a global positioning system (GPS) . 
Based upon inputs from the sensors, controller 26 may 
control a safety device 38. Depending on the desired 
sensitivity of the system and various other factors, not all 
the sensors 20, 28, 32, 34, 35, 36, and 37, or various 
combinations of the sensors, may be used in a commercial 
embodiment. Safety device 3 8 may control an airbag 40, an 
active braking system 41, an active front steering system 
42, an active rear steering system 43, an active suspension 
system 44, and an active anti-roll bar system 45, or 
combinations thereof. Each of the systems 40-45 may have 
their own controllers for activating each one. As mentioned 
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above, the safety system 3 8 may be at least the active 
braking system 41. 

[0048] Roll rate sensor 34 may sense the roll condition 
of the vehicle based on sensing the height of one or more 
points on the vehicle relative to the road surface. Sensors 
that may be used to achieve this include a radar-based 
proximity sensor, a laser-based proximity sensor and a 
sonar-based proximity sensor. 

[0049] Roll rate sensor 34 may also sense the roll 

condition based on sensing the linear or rotational relative 
displacement or displacement velocity of one or more of the 
suspension chassis components which may include a linear 
height or travel sensor, a rotary height or travel sensor, a 
wheel speed sensor used to look for a change in velocity, a 
steering wheel position sensor, a steering wheel velocity 
sensor and a driver heading command input from an electronic 
component that may include steer by wire using a hand wheel 
or joy stick. 

[0050] The roll condition may also be sensed by sensing 

the force or torque associated with the loading condition of 
one or more suspension or chassis components including a 
pressure transducer in active air suspension, a shock 
absorber sensor such as a load cell; a strain gauge, the 
steering system absolute or relative motor load, the 
steering system pressure of the hydraulic lines, a tire 
lateral force sensor or sensors, a longitudinal tire force 
sensor, a vertical tire force sensor or a tire sidewall 
torsion sensor. 

[0051] The roll condition of the vehicle may also be 
established by one or more of the following translational or 
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rotational positions, velocities or accelerations of the 
vehicle including a roll gyro, the roll rate sensor 34, the 
yaw rate sensor 28, the lateral acceleration sensor 32, a 
vertical acceleration sensor, a vehicle longitudinal 
acceleration sensor, lateral or vertical speed sensor 
including a wheel -based speed sensor, a radar-based speed 
sensor, a sonar-based speed sensor, a laser-based speed 
sensor or an optical-based speed sensor. 

[0052] Based on the inputs from sensors 20, 28, 32, 34, 
35, 36, 37, controller 26 determines a roll condition and 
controls any one or more of the safety devices 40-45. 

[0053] Speed sensor 20 may be one of a variety of speed 
sensors known to those skilled in the art. For example, a 
suitable speed sensor 20 may include a sensor at every wheel 
that is averaged by controller 26. The controller 26 
translates the wheel speeds into the speed of the vehicle. 
Yaw rate, steering angle, wheel speed and possibly a slip 
angle estimate at each wheel may be translated back to the 
speed of the vehicle at the center of gravity. Various 
other algorithms are known to those skilled in the art. For 
example, if speed is determined while speeding up or braking 
around a corner, the lowest or highest wheel speed may not 
be used because of its error. Also, a transmission sensor 
may be used to determine vehicle speed. 

[0054] Referring now to Figures 4A and 4B", controller 26 

is illustrated in further detail. There are two major 
functions in controller 26: the rollover trend 
determination, which is called a sensor fusion unit, 27A and 
the feedback control command unit 27B. The sensor fusion 
unit 27A can be further decomposed as a wheel lift detector 
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50, a transition detector 52 and a vehicle roll angle 
calculator 66. 

[0055] Referring now to Figure 5, the sensor fusion unit 
27A is illustrated in further detail. The sensor fusion 
unit 27A receives the various sensor signals, 20, 28, 32, 
34, 35, 36, 37 and integrates all the sensor signals with 
the calculated signals to generate signals suitable for roll 
stability control algorithms. From the various sensor 
signals wheel lift detection may be determined by the wheel 
lift detector 50. Wheel lift- detector 50 includes both 
active wheel lift detection and active wheel lift detection, 
and wheel grounding condition detection. Wheel lift 

detector is described in co-pending U.S. provisional 
application serial number 60/400,375 (Attorney Docket 202- 
0433/FGT-1683 PRV) filed August 1, 2002, which is 
incorporated by reference herein. The modules described 
below may be implemented in hardware or software in a 
general purpose computer (microprocessor) . From the wheel 
lift detection module 50, a deterraination of whether each 
wheel is absolutely grounded, possibly grounded, possibly 
lifted, or absolutely lifted may be determined. Transition 
detection module 52 is used to detect whether the vehicle is 
experiencing aggressive maneuver due to sudden steering 
wheel inputs from the driver. The sensors may also be used 
to determine a relative roll angle in relative roll angle 
module 54. Relative roll angle may be determined in many 
ways. One way is to use the roll acceleration module 58 in 
conjunction with the lateral acceleration sensor. As 
described above, the relative roll angle may be determined 
from the roll conditions described above. 
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[0056] The various sensor signals may also be used to 
determine a relative pitch angle in relative pitch angle 
module 56 and a roll acceleration in roll acceleration 
module 58. The outputs of the wheel lift detection module 
50, the transition detection module 52, and the relative 
roll angle module 54 are used to determine a wheel departure 
angle in wheel departure angle module 60. Various sensor 
signals and the relative pitch angle in relative pitch angle 
module 56 are used to determine a relative velocity total in 
module 62. The road reference bank angle block 64 

determines the bank angle. The relative pitch angle, the 
roll acceleration, and various other sensor signals as 
described below are used to determine the road reference 
bank angle. Other inputs may include a roll stability 
control event (RSC) and/or the presence of a recent yaw 
stability control event, and the wheel lifting and/or 
grounding flags. 

[0057] The global roll angle of the vehicle is determined 
in global roll angle module 66. The relative roll angle, 
the wheel departure angle, and the roll velocity total 
blocks are all inputs to the global roll angle total module 
66. The global roll angle total block determines the global 
roll angle 6^* An output module 68 receives the global roll 
angle total module 6 6 and the road reference bank angle from 
the road reference bank angle module 64. A roll signal for 
control is developed in roll signal module 70. The roll 
signal for control is illustrated as arrow 72 . A 
sensitizing and desensitizing module 74 may also be included 
in the output module 68 to adjust the roll signal for 
control . 
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[0058] In the reference road bank angle module 64, the 

reference bank angle estimate is calculated. The objective 
of the reference bank estimate is to track a robust but 
rough indication of the road bank angle experienced during 
driving in both stable and highly dynamic situations, and 
which is in favor for roll stability control. That is, this 
reference bank angle is adjusted based on the vehicle 
driving condition and the vehicle roll condition. Most 
importantly, when compared to the global roll estimate, it 
is intended to capture the - occurrence and physical magnitude 
of a divergent roll condition (two wheel lift) should it 
occur. This signal is intended to be used as a comparator 
against the global roll estimate for calculating the error 
signal which is fed back to roll stability controller 26. 

[0059] Referring now to Figure 6, the operation of the 
wheel departure angle block or module 60 is described in 
further detail. The wheel departure angle, ^wda ' between the 
axle or axis of the wheels and the average road surface is 
computed. This angle tries to fill the gap left when the 
relative roll angle is calculated in the relative roll angle 
module 54. The present embodiment allows a determination of 
the relative roll angle between the vehicle body and the 
road surface during a potential rollover event particularly 
where one or two inside wheels are lifted. This variable is 
used to boost roll_signal_f or_control (the true relative 
roll angle between the vehicle body and the road surface) , 
which is fed to the output module 6 8 for computing feedback 
control command. If this calculated value is less than the 
actual wheel departure angle, it might reduce the needed 
control command (under-control ) ; if thus calculated value is 
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greater than the actual wheel departure angle, it might 
increase the needed control command (over-control) . 

[0060] The external inputs to the wheel departure block 
60 are obtained in step 80: 

Roll velocity total: ^^tot * (sometimes written as 

Past value of the wheel departure angle: ^wda 

Transition flags: ^trafisition(^) front left wheel 

and Si^^^sition(^) front right wheel. 

[0061] In step 82, the relative roll angle is 

determined. 

[0062] In step 84 the wheel lift status flags: 5^/^ 

If the ith wheel is absolutely grounded, then 
S^l^iO = ABSOLUTELY ^GROUNDED 

If the ith wheel is in the edge of grounding, 
Swld (0 = POSSIBLY ^GROUNDED 

If the ith wheel is absolutely lifted, then 
Sy^ld (0 = ABSOLUTELY _ LIFTED 

If the ith wheel is in the edge of lifting 
Swld (0 = POSSIBLY _ LIFTED 

If the ith wheel's status cannot be firmly 
identified, 5^/^(0 = NO ^INDICATION 

Predefined Calibratable Parameter Definitions are 
determined in step 86 . 
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Wheel departure angle smoothing ratio: /? , in the 
present example a value of 1.1 is used. 

Relative roll angle threshold for starting wheel 
departure angle computation during transition 
maneuver (transition flag is active) pre-charge 

act i ve : ® transition-active 
where ® transition-active ~ ^yp 

* ROLL _ GRADIENT and Ay^ 

reflects the threshold for the percentage of 
ROLL_GRADIENT, default value 40%. 

Relative roll angle threshold for starting wheel 
departure angle computation during initial wheel 
lifting: 

where = ^yb\ ^^LL _GRADIENT and Ay^i reflects the 

threshold for the percentage of ROLL_GRADIENT . In 
this example, a value of 75% is used. 

Relative roll angle threshold for starting wheel 
departure angle computation during medium wheel 
lifting: 02 

where Q2 = ^ybl"^ ^OLL_GRADIENT and /l^^2 reflects the 

threshold for the percentage of ROLL_GRADIENT . In 
this example, a value of 50% is used. 

Wheel departure angle threshold for starting wheel 
departure angle computation during medium wheel 
lifting: 

where = Ay^2 * ROLL _ GRADIENT and Ay^2 reflects 

the threshold for the percentage of ROLL_GRADIENT . 
In this example, a value of 2 5% is used. 
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Relative roll angle threshold for starting wheel 
departure angle computation during high wheel 
lifting: ©3 

where = ^yb3^ ^OLL_GRADIENT and Ay^-^ reflects the 

threshold for the percentage of ROLL__GRADIENT . In 
this example, a value of 40% is used. 

Wheel departure angle threshold for starting wheel 
departure angle computation during high wheel 
lifting: 

where W 2, = Ay^^,* ^OLL_ GRADIENT and ^^^3 reflects 

the threshold for the percentage of ROLL_GRADIENT . 
In this example, a value of 7 5% is used. 

Wheel departure angle filter coefficient: a. In 
this example, a value of 511/512 is used. 

Wheel departure angle lower bound: ^min • this 
example, a value of -10 degrees is used. 

Wheel departure angle upper bound: ^max • this 
example, a value of 10 degrees is used. 

[0063] A local temporary variable used is the Wheel 
departure angle intermediate value: ^wda-int - 

[0064] When the vehicle is highly lifted on one side 

(inside in a turn), the relative roll calculated from the 
relative roll angle module 54 in step 82 may not capture the 
true relative roll angle between the vehicle body and the 
road due to lateral acceleration saturation and gravity 
component in the lateral accelerometer . Figure 2 shows the 
angles involved in this case. The relative roll angle 0^^,. is 
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the angle due to suspension height variation (also called 
chassis roll angle or suspension roll angle) , which is 
intended to capture the relative roll between the axle and 
the vehicle body. The global roll angle 6^^ is the roll 
angle of the vehicle body with respect to the sea level . 
The wheel departure angle By^da used to capture the 

relative roll angle between the axle and the road surface. 
The road bank angle Qbank relative angle between the 

road surface and the sea level . 

[0065] Considering the angles in Figs. 2 and 3, the 
following relationship is true : 

^wda = ~ ^xr " ^bank ( 1 ) 

[0066] Notice that in equation ( 1 ) only two variables are 
known: the total roll angle velocity 6^ ( jRV^^^ ) and the 
suspension relative roll angle 6^^ . Using these known values 
the wheel departure angle 0^^^ is computed. 

[0067] The roll velocity total R^toi ^® computed from 

roll rate sensor signal, yaw rate sensor signal and the 
pitch rate sensor signal in the following formula: 

where (Oj^ is the roll rate signal, O)^ is the yaw rate signal 
and dy^ is the relative pitch angle and Oyrss ^ steady 

state capture of the pitch angle. 

[0068] The relative roll angle 6^^ and relative pitch may 
be determined as set forth in U.S. Patent 6,556,908, which 
is incorporated by reference herein. 
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n -If ^x-susp , 



COS(^^^;.) 



where ®y-susp ^x-susp calculated as described in the 

following. Two variables as defined at each sampling 
instant : 

RRA_RAW{k) = —cd^(k)-^a^(k) 

1 (4) 
RPA_RAW(k) = —a) (k)--^a^(k) 

where the coefficients CQ,C\,dQ,cly can be obtained based on the 
vehicle parameters (see US6556908 for detail), cby is an 
estimation of the pitch rate signal, which can be calculated 
as cby = dy SQ^c{dj^)'{- CO^ t3Xi{0j^) if there is an estimation of the 

pitch angle 6^ is available. Then at the (k+l)th sampling 

instant (current values), the estimates of ® jc-^wsp + 1) ^^"^ 

®y_^^^gp{k + \) may be computed from their values in the kth 

sampling instant (past values) and the current and past 
values of RRA_RAW and RPA_RAW . The iterative formula may 
be expressed as the following with properly chosen 
coefficients ^c^l'/o f\ - 

®x-susp 1) = ^O^x-susp (*) + ^1 ^RAW{k'\r\) + RRA _ RAW{k)\ 
®y-susp + = fo^y-susp + f\ V^PA _RAW{k^\)^ RPA _RAWm 

(5) 

[0069] Equation (1) may be rewritten as the following 
dt dt 
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or 

/ 

^wda (0 = \RV{r)dT - d^^^i, it) ( 7 ) 

0 

where RV is calculated from the known roll velocity total 
and the relative roll velocity 

dd^^ it) 
at 

[0070] The wheel lift status is also factored into the 
determination of the wheel departure angle through (7) by 
identifying when the integration in (7) should start and 
end. Assume at time instant , one or two wheels of the 
vehicle start to depart from contacting the road surface 
(based on the wheel lifting information or any other wheel 
lifting indication) and before time instant tQ all the wheels 
of the vehicle are grounded. Let the road bank angle at 
time ^0^^ ^bO ' then 

0= \RV{T)dT^e^^ (9) 
0 

[0071] At time instant t such that tQ<t<tj (tj is the 

time instant when the lifted wheels come back to contact the 

road surface), (9). is subtracted from (7) to obtain the 
following 

Swda (0 = \RV(j)dT - [0i,^„k (0 - (10) 
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[0072] If the vehicle is on level ground then ^bank-^' 

the vehicle is on a constant road bank (i.e., ^bank ~ ^bO ^ * 
then (10) is the same as 

^Wa(0 = ^W^(0 (11) 

where the approximate or estimated Owda defined as the 

following 

0^^a(O= lRV(T)dT (12) 

^wda computed in (12) is a good approximation of the actual 
wheel departure angle O^da change in the road bank 

angle (delta road bank A^^^^^ ) 

^0bankiO = 0bank(t)-0bO ' (13) 

is negligible with respect to Oy^^ia • 

[0073] The following is a list of cases where the change 
in the road bank angle is zero or very low: 

If the vehicle is driven on a level ground, then 
the delta road bank is zero and ffy^da actual 
departure angle. 

If the vehicle is not driven on a transient road 
bank, or say the vehicle is driven on a steady 
state bank road, then the delta road bank is close 

to zero and ^^da close to the actual wheel 

departure angle. 
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If during wheel lifting, the road bank does not 
change much in comparison with the road bank at 
the initial wheel lifting time instant, then the 

delta road bank can be negligible and dy^cla ^® close 
to the actual wheel departure angle. 

If during wheel lifting the vehicle is driven very- 
aggressive such that the roll velocity due to the 
road bank is much smaller than the roll velocity 
due to the wheel departure and the relative roll, " 

then the delta road bank can be negligible and O^^la 
is close to actual wheel departure angle. 

[0074] The aforementioned cases cover large portion of 
the scenarios where the wheel lifting could happen. Notice 
that since the delta road bank comes from taking away 6^^ 
from the actual road bank, and wheel lift event usually 
happens in seconds, the magnitude of delta road bank is 
relatively much smaller than the actual road bank. 
Therefore, if in cases where delta road bank is non-zero, 

its magnitude should be less than the magnitude of d^^^a • As 
shown below, a small non-zero error may not cause an adverse 
control effect. 

[0075] First, the increased magnitude of delta road bank 

case is considered, i.e., the magnitude of the road bank is 
greater than the magnitude of the road bank at the time of 
entering wheel lifting. Since increased magnitude of the 
road bank helps stabilize the vehicle for on-camber driving 

(Figs 3a, 3c), hence less likely the control will be. needed. 
While for off-camber driving (Fig 3B and 3D) , increased 
magnitude of road bank will worsen the stability of the 
vehicle and it needs special control attention. Assume the 
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vehicle is turning left. In this case, A^^q„^>0, and the 
actual wheel departure angle Oy^da positive. Therefore, 

&v.da-Q^da ^-^Sbank <0 (14) 
or say the magnitude of the calculated wheel departure angle 
dy^fia greater than the actual wheel departure angle. This 

means the error due to delta road bank in this case will 
generate an over-estimated wheel departure angle, which 
generates an over-control command and helps control . Hence 
the error does not have an adverse effect. In a right turn, 
^^bank ' and the actual wheel departure angle Owda 
negative . Therefore , 

^Wa-^w<i« =-A^£,a„* >0 ■ (15) 

or say the magnitude of the calculated wheel departure angle 
d^cia greater than the actual wheel departure angle. 

Hence, the error does not have an adverse effect. 

[0076] When the magnitude of the road bank is decreasing, 
i.e., the magnitude of the road bank is less than the 
magnitude of the road bank at the time of entering wheel 
lifting. Since decreased magnitude of road bank helps 
stabilize the vehicle for off-camber driving, control is 
less likely to be needed. While for on-camber driving, 
decreased magnitude of road bank will worsen the stability 
of the vehicle and control is needed. Assume the vehicle is 
turning left. In this case, A^^^^^^, > 0 , and the actual wheel 
departure angle 9y^da positive. Therefore (14) is true, 

i.e., the magnitude of the calculated wheel departure angle 
6^^^ is greater than the actual wheel departure angle. Hence 
the error does not have adverse effect. Assume the vehicle 
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is turning right. In this case, ^^bank * ecndi the actual 
wheel departure angle 0^^^ is negative. Therefore (15) is 
true, i.e., the magnitude of the calculated wheel departure 
angle O^^a is greater than the actual wheel departure angle. 
Hence the error does not have adverse effect. 

[0077] In summary, the error due to small magnitude of 
the delta road bank in the computation of wheel departure 
angle using (12) does not reduce control effort when the 
control is most likely needed. 

[0078] A more accurate implementation of equation (12) 
thus identifies the time in which the wheels lift at and 
the time in which the wheels are no longer lifted, time 
instant t j , or say the conditions where the wheel lifting 

can be detected in steps 88 and 90. That is, (12) may be 
theoretically implemented as in step 92 as in the following: 

if {6^, > 0 & &{S^i^ (0) = ABSOLUTELY _ LIFTED \\ S^i^ (2) = ABSOLUTELY _ LIFTED)) 
II (0^^ <0&&(S^i^ (1) = ABSOLUTELY _ LIFTED || S^^ (3) = ABSOLUTELY _ LIFTED))) 

{ 

^wda = ^wda + /?V/ * P - LOOP _ TIME ^ SEC\ 

} 

else 
{ 

} 

[0079] In the above, the wheel departure angle is 

determined when the relative roll angle is greater than or 
equal to 0 and the left side wheel (0) and (2) are 
absolutely lifted or the relative roll angle is less than 
zero and the right side wheels are absolutely lifted. 
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[0080] Considering the current wheel lift status 5^/^(0s 
for / = 0,1,2,3 sometimes have delays, the above computation may 
end up with an under-estimated Owda fact that 

integration is delayed. Therefore, there is a need to 
extend the absolutely lifted condition beyond the time set 
by the wheel lifting status by a predetermined time in step 
94 . The predetermined times are determined by the 

thresholds . The following flag is used to extend wheel 
lifting condition to include conditions involving relative 
roll angle and the past value of the wheel departure angle. 

WHEEL _ LIFTING _ CONDITION 

= \\\0.r l^ei 

IKI^,, I>e3 && \a^^,\> H'3)) 

II (6^,, > 0 & &(5^^^ (0) = ABSOLUTELY . LIFTED \\ S^u (2) = ABSOLUTELY _ LIFTED)) 
II (0^^ <OSl&(S^ij (1) = ABSOLUTELY _ LIFTED \\ S^i^ (3) = ABSOLUTELY _ LIFTED))) 

Consider the fact that during an aggressive maneuver which 
activates the pre-charge control, the wheel lifting is 
likely to happen, further time extension of the wheel 
lifting condition is needed 

TRANSITION _ WHEEL _ LIFTING _ CONDITION 

^ transition (^) 1 & & 9xr — ® transition-active ) 
II transition ~~ 1 & & Oxr '® transition-active ) 

[0081] On the other hand, the pure integration here might 

introduce numerical error, hence the pure integration is 
replaced by the following high-pass-filtered integration 

GwdaAnX = ^ * ^wda-int + V * AT^ (16) 
where AT is the loop time used in the ECU. 

[0082] Notice that the wheel departure angle is assumed 

to be in the same trend as the relative roll angle. In 
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order to achieve this, the sign enforcement and a numerical 
limitation are implemented as in the following: 

^wda-\iA = minC^Pniax'maxC^ivda-int.O)); 

else 

^wda-iM = max(4'n,in,min(^^rf^.i„t,0)); 

[0083] When the wheel lifting conditions are not met, or 
the vehicle potentially does not have any lifted wheels and 
is beyond the time described above, the integration will be 
terminated in step 96, i.e., the wheel departure angle 
computation will be terminated through the following 

if ((WHEEL _ LIFTING _ CONDITION == 1 

II TRANSITION _ WHEEL _ LIFTING _ CONDITION = 1)) 

{ 

if (d^, > 0) 

{ if (S^i^m == ABSOLUTELY _GROUNDED 
&& 5^/^ [2] = ABSOLUTELY _GROUNDED) 

^wdaAnt " ^» / 

else 

{ if (5^^/^[l] == ABSOLUTELY _ GROUNDED 

&& 5^/^ [3] = ABSOLUTELY _GROUNDED) 

^wda-ini ~ ^*» 1 
^wda ~ ^wda-'int » 

} 

else 
{ 

^wda-ini ~ ^' 
^wda - ^wda I P'^ 

} 

[0084] The following is a detailed implementation of the 
afore-mentioned algorithm to compute the wheel departure 
angle 6^^^ • 
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'/ ( transition ^ *^ ^xr ~ ^transition-active^ 

II transition (P) 1 & & S^r ^ '^transition-active ) 
lll^.rl^©l 

||(|^,,,|>e2 && |^^dwl^^2 
11(1 6*^, |> 03 && |e^^|> T3)) 

II (0j,r > 0&&(S„u (0) = ABSOLUTELY _ LIFTED \\ S„ui (2) = ABSOLUTELY _ LIFTED)) 
II {e„ <0& (1) = ABSOLUTELY _ || S„,j (3) = ABSOLUTELY _ LIFTED))) 

{ 

'/ (^^r > 0) 
{ 

^wJa-m = min(0n^x.i"ax(^^^.ini,O)); 
'/ iS^ijlO] = ABSOLUTELY _GROUNDED 
&& S„ia{2\ = ABSOLUTELY _GROUNDED) 

} 

else 
{ 

^wda-im = max(0,^n,min((9^j^.ini,O)); 

('S^ww[0 == ABSOLUTELY ^GROUNDED 
&& S,^/j[3] = ABSOLUTELY _GROUNDED) 

-waa-iiii "» 

> 

} 

else 
\ 

^wda ~ ^wda / P '^ 

) 

[0085] Thus, as can be seen, the various threshold 

conditions must be met before determining the wheel 
departure angle from (16). If the conditions are not met 
e^^^ is set to 0. 

[0086] Referring now to Figure 1, a comparison between 

the true body roll angle (from a laser sensor) and the 
calculated roll angle by adding the wheel departure angle to 
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the relative roll angle was performed in a vehicle. The 
laser sensor was used in a test to confirm the results set 
forth herein. A laser sensor is expensive and is not used 
in production. As can be seen, the true roll and the Oy^da 
plus relative roll angle are nearly equal. This indicates 
that the calculated wheel departure angle Oy^^a fill the 

gap between the vehicle true roll angle and the calculated 
relative roll angle 0^^. during potential rollover event. 

[0087] The above computation focuses on obtaining a good 
(maybe overestimated) quantity to characterize WDA when the 
control is needed. Hence it might be possible during a 
transition from a non-event case to an event case, the 
computation generates a WDA which could trigger unnecessary 
control. On the other hand, the sensor signals are measured 
in the sensor frames and the sensor cluster frames are 
likely different from the vehicle body- fixed frames due to 
the sensor mounting errors (current sensor mounting errors 
could be around 3 degrees. Also if there is an uneven 
loading between front and rear axle (for excimple, a SUV 
could have a large loading in its trunk) , the vehicle might 
have a slight pitch towards the rear of the vehicle. Such a 
pitch is called a loading-induced pitch misalignment (LPM) . 
Due to LPM, the roll rate sensor will generate a non-zero 
output during vehicle yawing even if the vehicle body 
doesn't roll at all. Hence such a vehicle loading- induced 
pitch misalignment could introduce errors in the computation 
of the wheel departure angle. It would be desirable to 
provide further improvement over the afore-mentioned WDA 
computation algorithm. 
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[0088] In this embodiment, instead of simply assuming 

conditions on the delta road bank, a further detail of the 
road bank velocity using road roll rate is considered 
together with afore-mentioned error sources. In this way 
the potential errors in WDA computation could be further 
reduced. More specifically, how to detect loading- induced 
pitch misalignment and how to take into account of the road 
roll rate is described. Although both are described, one or 
both may be implemented. More specifically, how to use 
those variables to compensate potential errors in the 
computation of wheel departure angle is considered. 

[0089] Consider the coordinate systems shown in Figure 8 

and Figure 9. ys~^~'^s ^s~^~^s fo2rmulate the sensor 

coordinate system on which the sensors are fixed. For 
example, the roll rate sensor output is along the 
direction. yt^^''^ ^b~^~^b formulate the vehicle body-, 

fixed coordinate system. The relative Euler roll and pitch 
angles, denoted as d^^bx ^sihy » between the sensor frame and 

the body frame are called the sensor misalignments. The 
static loading- induced pitch misalignment is denoted as O^pf^ . 

[0090] The vehicle body Euler roll angle (with respect to 
the sea level, is also called global roll angle) 
satisfies the following 

&y.=0),,+CO,^e^ (17) 

where CO^^^ and co^^ are the roll and yaw angular rates of the 

vehicle body along the body-fixed and axes, 6^^ is the 

vehicle body Euler pitch angles with respect to the sea 
level . 
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[0091] A similar equation holds for the moving road 
frames ^^^2^^ ^ i.e., the Euler angles of the average road 
surface (moving with the vehicle body) with respect to the 
sea level 

^bank = ^ro^ulx + ^ romiz^ slope ( 1 8 ) 

where co^oTuu ^roadz roll and yaw angular, rates of 

the moving road frames r^r^r-^, which are fixed on the average 
of the road surface that is translating and yawing with the 
vehicle / d^^^^,^ and 6^1^^^ are the Euler angles between the moving 

road frame and the sea level, which reflect the road bank 
and the road inclination respectively. 

[0092] By differentiating the vehicle body frame from the 
senor frame, the wheel departure angle can be rewritten as 
the following in contrast to (1) 

where 6^^ is the roll angle between the wheel axle and the 

vehicle body, or say it is the dynamics induced suspension 
roll angle which is calculated • in (3). 

[0093] Since the available signals are from the sensor 

signals, the above body frame quantities need to be 
expressed from the sensor frame variables. Denote as 
^^v2/w» ^^s2by misalignment angles between the sensor frame 

and the body frame, the following is true 

0 -0 AO 

where ^^.^ and 0^^ are the roll and pitch angles of the senor 
frame with respect to the sea level. A0^2bx^^^s2by usually 
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constant, hence their time derivatives must be zero. 
Therefore by differentiating (20), it is not hard to derive 
that 

4.=^^ (21) 

[0094] Hence the wheel departure angle velocity is not 
affected by the sensor roll misalignment but it is affected 
by the pitch misalignment as described below, 

[0095] In the sensor frame the following equation similar 

to (17) and (18) is true 

[0096] Notice that, the vehicle body global pitch angle 
6^^, includes the Euler pitch angle of the moving road frame, 

the dynamics induced relative pitch angle 6y^ , the sensor 

pitch misalignment ^^siby and the loading- induced pitch 

misalignment 6^^^ , i.e., 

Notice also that in the rollover event, it is assumed that 
pitchover does not happen and that the front two-wheels have 
not lifted or that the rear two-wheels have not lifted. 
Hence there is no analog of wheel departure for the pitch 
motion. This is true for rollover control since the 
majority of the vehicle motion energy is directed to the 
roll direction. 
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[0097] By using (18), (19), (21) and (22), the velocity 
of the wheel departure angle can be expressed as functions 
of the sensor frame angular rates, the road frame angular 
rates, the sensor frame pitch angle and the road inclination 
slope as 

[0098] Consider that the sensor yaw rate and the moving 

road roll rate are related through the involved sensor 
misalignment, the suspension induced relative pitch angle 6^,^ 

and the loading induced pitch misalignment angle and during 
roll stability control WDA is kept not exceeding a limit 
(for example, less than 10 degree), hence we have 

(24) can be further written as in the following 

^vv.i^. ===(^..-^r...i.)-^..+^.vz(^.^-^.^^^^^ ^^^s^,y^Qyr)^ slope (26) 

[0099] During a rollover event, the pitch motion is the 
secondary motion, i.e., the majority of the motion energy is 
directed to the roll motion. Also notice that the pitch 
rate is usually small hence the term <2^^.^sin(^^p^ + A^^.j^^ 

is small in comparison with the other terms in (26). Thus, 
the following simplification for the wheel departure angle 
velocity may be derived 

» - oj^^ + co^ {Ou.^ + A^,,,, +e^,)-e„ (27) 
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[00100] In summary, (27) implies that the following 
variables directly affect the computation of the wheel 
departure angle velocity: 

The sensor roll angular rate CO^ ; 

The road roll angular rate (O^^i^ ; The sensor yaw 
rate (O^^ ; 

The relative roll angle 6^ (suspension induced 
roll angle) ; 

The relative pitch angle 6^^ (suspension induced 
pitch angle) ; 

The sensor pitch misalignment . 

[00101] Notice that the sensor frame pitch and the road 
slope do not appear in the above format of computation of 
the wheel departure angle velocity while in the old 
computation they do appear. By closely checking the two 
methods, it is fair to say that the newly introduced road 
roll rate includes the pitch influence. One explanation is 
that the current method takes advantage of the relative 
concept in pitch portion instead of using the relative 
concept in the roll portion. The involved global quantities 
in the current method are the sensor roll rate and the road 
roll rate. Also notice that due to the relative feature of 
the wheel departure angle, WDA is not affected by the roll 
sensor misalignment ^d^iux • 

[00102] Consider two cases of known road roll rate. The 
first is the one, where the vehicle is driven on a flat road 
which could be tilted with a tilt angle ^ , Assume the 
vehicle is turning constantly on this tilted flat road 
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surface, it is not hard to compute the road bank angle and 
the road slope angle experienced by the vehicle 



where 6^ reflects the initial road bank and slope angles 

experienced by the vehicle. Based on (28), the road roll 
rate can be readily solved as 

CO , =ft X. -OJ ,6 , =0 (29) 

^romix ^bank ^madz^ slope ^ . \^ ^ i 

[00103] Therefore, if a vehicle is driven on a flat road 
regardless a tilted or a level ground,, the WDA velocity can 
be readily calculated as the following 

- + O),, ( d^^ + A 2 + ) - 4. (30) 

[00104] However, the road slope would have significant 
influence in vvDA velocity in other cases. One of such cases 
is when the vehicle is driven on a spiral road surface (such 
as a parking garage) , where the road bank is close to zero 
and the road slope is constant. In such a case, the road 
roll rate is non-zero even if the road bank angle and its 
velocity are zero 

^roatlx ^bank ^rotulz^ slope ^ro<ulz^ slope ' (31) 

[00105] Equation (31) also implies that in a spiral road 
driving, even though the vehicle does not have roll motion 
at all, the roll rate sensor has non-zero output. In such 
case, the WDA velocity might be readily calculated as 
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sx sz sy xr 

[00106] A similar case is when the vehicle is turning on a 
constant bank road, even the road doesn't have any pitch, a 
pitch rate sensor fixed on the road frame has non-zero 
output. This simple observation might well be used to 
justify why angle information cannot be simply obtained from 
integrating a corresponding angular rate signal. 

[00107] The ordinary road is going to be in between a pure 
spiral road (constant slope and zero bank) and a tilted flat 
road. Hence the road roll rate should have a value in 
between the road roll rates corresponding to the above two 
extreme cases . 

[00108] In the following, pitch misalignment computation 
will be provided. Such a pitch misalignment includes both 
the loading-induced pitch misalignment and the sensor 

mounting misalignment ^^siby * this is called the augmented 
pitch misalignment and denote it as A^^^ 

A^xPM =^L/.«+A^.2*y (33) 

[00109] Referring now to Figure 10, the various sensor 
inputs are calculated in step 100. First, the detection of 
the pitch misalignment is determined in step 102 . The 
different pitch angles involved are depicted in Figure 8. 
If a moving vehicle is driven with constant yaw rate on a 
flat road, the total vehicle angular rate vector 0)^^,,a in^st be 
perpendicular to the road surface regardless of the road 
bank and road inclination. If there is no augmented pitch 
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misalignment, i.e., A^^p^=0, then the yaw rate sensor output 

co^^ coincides with the total vehicle angular rate vector co^^^^^ 

and the roll angular rate sensor output must be zero. If 
the augmented pitch misalignment is non-zero, then both the 
roll angular rate and yaw rate sensor outputs have non-zero 
outputs. Further, the total angular rate vector must have 
the magnitude of the square roots of the square sum of the 
roll rate and yaw rate, i.e. 



= 4<+< (34) 



[00110] Therefore, as shown in Figure 10, the augmented 
pitch misalignment can be computed as 



^e^p^ = sin"' 



' CO... 



(35) 



[00111] If the vehicle is not driven on a flat surface, 
for example, if the vehicle is driven on a spiral road such 
as a parking garage, the road pitch would be included in the 
computation in (35) . In this case, the above computation 
would generate an erroneous pitch misalignment. Hence the 
spiral driving condition needs to be excluded from (35). 

[00112] Notice that (35) is meaningful when the vehicle is 
in a steady state yawing motion, the vehicle does not have 
large maneuver-induced roll and pitch (namely, the relative 
roll and pitch as calculated in Ford patent, US 6,556,908), 
which is incorporated by reference herein. In order to 
provide a further robust estimation, an average algorithm 
will be used as in the following 
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START 

if k < N & & (vehicle is in steady state yawing and the road is flat) 

k=k + i 
else if k - N 
k=0 

send out augmented pitch misalignment 
go to START 



[00113] Notice that steady state driving on a flat road 
can be monitored based on sensor signals, the instantaneous 
computation in (35) and the following calculated variables 
together with other control status 



^yin« =Sin 



-1 f ^x-Q.y-Q^«^t« | 



(36) 



where is the lateral velocity based on the side slip 

angle calculated from a linear bicycle model using steering 
wheel angle, yaw rate and lateral acceleration. 

[00114] Using the above-calculated augmented pitch 
misalignment, the sensor outputs in step 104 may be 
compensated as in the following 

^^xc = cos(A^^^^ ) - co^ sin(A0^p^ ) 

^yc ^sy 

[00115] The computation of the road roll rate is 
determined in step 106. If the vehicle is driven on a flat 
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surface, which could be a level ground or a tilted ground, 
regardless if it is a dynamic or a steady state driving 
condition, then the road angular rate must always be set to 
zero and WDA velocity should satisfy the following 

(38) 

d.aa = + 6;,, ( A 0^ + e^,^ ) - e^^ 

[00116] If the vehicle is driven on a non-flat surface in 
a steady state turning condition, then the road roll rate 
and WDA velocity should satisfy the following 

(39) 

6 , -co -{-co 6 . -6 

[00117] If the vehicle is driven on a non-flat surface in 
a dynamic turning condition, then the road roll rate needs 
to be adjusted as in the following 



^roadx ^rotidx ^down » 

if{co^^<0) 



(40) 

[00118] If the vehicle is driven on dynamic roll condition 
with wheel lifting, then the vehicle is in a potential 
rollover event. In most of the cases, all the vehicle 
motion energy is directed to the roll direction, the vehicle 
could be thought as driven on a flat surface 

CO , =0 

(41) 
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[00119] In implementation, the wheel lifting state is 
determined in step 108 as described above. Thus, the 
following is conducted 

if (there is 1 AL) 

^roatlx ^mtulx ^down ' 

else if (there are 2 AL) 

else if (transition from 2 AL to 1 AL) 

if i^roruLc ^ 0 & &^_^ > ^y,, ) 

CO , —CO , —r ; 

roiutx ^roeulx up » 

else if (transition from 1 AL to 0 AL 
or AG condition) 

Where r^^^^^„ and r^^ are a ramping down rate and a ramping up 
rate for the road roll rate. /? is a positive niomber greater 
than 1. AL denotes absolutely lifted condition identified 
from the wheel lift detection algorithms and AG denotes the 
absolutely grounded condition identified from the wheel lift 
detection algorithm. 

[00120] Thus, because the augmented pitch alignment and 
road roll rate, the wheel departure angle may be determined 
in step 110 by using equation (34) . The road roll rate 
takes into consideration the ramping up and down rates as 
well as the lifting conditions of the wheel. 

[00121] While particular embodiments of the invention have 
been shown and described, numerous variations and alternate 
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embodiments will occur to those skilled in the art. 
Accordingly, it is intended that the invention be limited 
only in terms of the appended claims . 
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